home *** CD-ROM | disk | FTP | other *** search
/ Ham Radio 2000 #1 / Ham Radio 2000.iso / ham2000 / tcp_ip / wnos / wn941101 / tcphdr.c < prev    next >
Encoding:
C/C++ Source or Header  |  1994-08-10  |  3.8 KB  |  158 lines
  1. /* TCP header conversion routines
  2.  * Copyright 1991 Phil Karn, KA9Q
  3.  */
  4. #include "global.h"
  5. #include "mbuf.h"
  6. #include "tcp.h"
  7. #include "ip.h"
  8. #include "internet.h"
  9.  
  10. /* Convert TCP header in host format into mbuf ready for transmission,
  11.  * link in data (if any). If ph != NULL, compute checksum, otherwise
  12.  * take checksum from tcph->checksum
  13.  */
  14. struct mbuf *
  15. htontcp(tcph,data,ph)
  16. struct tcp *tcph;
  17. struct mbuf *data;
  18. struct pseudo_header *ph;
  19. {
  20.     int16 hdrlen = TCPLEN;
  21.     struct mbuf *bp;
  22.     char *cp;
  23.  
  24.     if(tcph->optlen > 0 && tcph->optlen <= TCP_MAXOPT){
  25.         hdrlen += tcph->optlen;
  26.     } else if(tcph->mss != 0){
  27.         hdrlen += MSS_LENGTH;
  28.     }
  29.     if((bp = pushdown(data,hdrlen)) == NULLBUF){
  30.         free_p(data);
  31.         return NULLBUF;
  32.     }
  33.     cp = bp->data;
  34.     cp = put16(cp,tcph->source);
  35.     cp = put16(cp,tcph->dest);
  36.     cp = put32(cp,tcph->seq);
  37.     cp = put32(cp,tcph->ack);
  38.     *cp++ = hdrlen << 2;    /* Offset field */
  39.     *cp = 0;
  40.     if(tcph->flags.congest)
  41.         *cp |= 64;
  42.     if(tcph->flags.urg)
  43.         *cp |= 32;
  44.     if(tcph->flags.ack)
  45.         *cp |= 16;
  46.     if(tcph->flags.psh)
  47.         *cp |= 8;
  48.     if(tcph->flags.rst)
  49.         *cp |= 4;
  50.     if(tcph->flags.syn)
  51.         *cp |= 2;
  52.     if(tcph->flags.fin)
  53.         *cp |= 1;
  54.     cp++;
  55.     cp = put16(cp,tcph->wnd);
  56.     if(ph == NULLHEADER){
  57.         /* Use user-supplied checksum */
  58.         cp = put16(cp,tcph->checksum);
  59.     } else {
  60.         /* Zero out checksum field for later recalculation */
  61.         *cp++ = 0;
  62.         *cp++ = 0;
  63.     }
  64.     cp = put16(cp,tcph->up);
  65.  
  66.     /* Write options, if any */
  67.     if(hdrlen > TCPLEN){
  68.         if(tcph->mss != 0){
  69.             *cp++ = MSS_KIND;
  70.             *cp++ = MSS_LENGTH;
  71.             cp = put16(cp,tcph->mss);
  72.         } else
  73.             memcpy(cp,tcph->options,tcph->optlen);
  74.     }
  75.     /* Recompute checksum, if requested */
  76.     if(ph != NULLHEADER)
  77.         put16(&bp->data[16],cksum(ph,bp,ph->length));
  78.  
  79.     return bp;
  80. }
  81.  
  82. /* Pull TCP header off mbuf */
  83. int
  84. ntohtcp(tcph,bpp)
  85. struct tcp *tcph;
  86. struct mbuf **bpp;
  87. {
  88.     char hdrbuf[TCPLEN], *cp;
  89.     int flags, hdrlen, optlen, kind, i = pullup(bpp,hdrbuf,TCPLEN);
  90.  
  91.     /* Note that the results will be garbage if the header is too short.
  92.      * We don't check for this because returned ICMP messages will be
  93.      * truncated, and we at least want to get the port numbers.
  94.      */
  95.     tcph->source = get16(&hdrbuf[0]);
  96.     tcph->dest = get16(&hdrbuf[2]);
  97.     tcph->seq = get32(&hdrbuf[4]);
  98.     tcph->ack = get32(&hdrbuf[8]);
  99.     hdrlen = (hdrbuf[12] & 0xf0) >> 2;
  100.     flags = hdrbuf[13];
  101.     tcph->flags.congest = flags & 64;
  102.     tcph->flags.urg = flags & 32;
  103.     tcph->flags.ack = flags & 16;
  104.     tcph->flags.psh = flags & 8;
  105.     tcph->flags.rst = flags & 4;
  106.     tcph->flags.syn = flags & 2;
  107.     tcph->flags.fin = flags & 1;
  108.     tcph->wnd = get16(&hdrbuf[14]);
  109.     tcph->checksum = get16(&hdrbuf[16]);
  110.     tcph->up = get16(&hdrbuf[18]);
  111.     tcph->mss = 0;
  112.     tcph->optlen = hdrlen - TCPLEN;
  113.  
  114.     /* Check for option field. Only space for one is allowed, but
  115.      * since there's only one TCP option (MSS) this isn't a problem
  116.      */
  117.     if(i < TCPLEN || hdrlen < TCPLEN)
  118.         return -1;    /* Header smaller than legal minimum */
  119.     if(tcph->optlen == 0)
  120.         return (int)hdrlen;    /* No options, all done */
  121.  
  122.     if(tcph->optlen > len_p(*bpp)){
  123.         /* Remainder too short for options length specified */
  124.         return -1;
  125.     }
  126.     pullup(bpp,tcph->options,tcph->optlen);    /* "Can't fail" */
  127.     /* Process options */
  128.     for(cp=tcph->options,i=tcph->optlen; i > 0;){
  129.         kind = *cp++;
  130.         /* Process single-byte options */
  131.         switch(kind){
  132.         case EOL_KIND:
  133.             i--;
  134.             cp++;
  135.             return (int)hdrlen;    /* End of options list */
  136.         case NOOP_KIND:
  137.             i--;
  138.             cp++;
  139.             continue;    /* Go look for next option */
  140.         }
  141.         /* All other options have a length field */
  142.         optlen = uchar(*cp++);
  143.  
  144.         /* Process valid multi-byte options */
  145.         switch(kind){
  146.         case MSS_KIND:
  147.             if(optlen == MSS_LENGTH){
  148.                 tcph->mss = get16(cp);
  149.             }
  150.             break;
  151.         }
  152.         optlen = max(2,optlen);    /* Enforce legal minimum */
  153.         i -= optlen;
  154.         cp += optlen - 2;
  155.     }
  156.     return (int)hdrlen;
  157. }
  158.